
/* void UpdateImuData(void)
{
    //获取姿态
    IMU.yaw = get_INS_angle_point()[0];
    IMU.pitch = get_INS_angle_point()[1];
    IMU.roll = get_INS_angle_point()[2];

    IMU.yawSpd = get_gyro_data_point()[2];
    IMU.pitchSpd = get_gyro_data_point()[1];
    IMU.rollSpd = get_gyro_data_point()[0];

    IMU.xAccel = get_accel_data_point()[0];
    IMU.yAccel = get_accel_data_point()[1];
    IMU.zAccel = get_accel_data_point()[2];
} */
